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ABSTRACT 

A nonlinear control scheme for attitude control of a spacecraft is combined with a nonlinear gyro bias observer 
for the case of constant gyro bias, in the presence of gyro noise. The observer bias estimates converge exponentially 
to a mean square bound determined by the standard deviation of the gyro noise. The resulting coupled, closed loop 
dynamics are proven to be globally stable, with asymptotic tracking which is also mean square bounded. A 
simulation of the proposed observer-controller design is given for a rigid spacecraft tracking a specified, time- 
varying attitude sequence to illustrate the theoretical claims. 

INTRODUCTION 

Combined observer-controller designs for the attitude control of rigid flight vehicles are a subject of active 
research 1,2 . Successful design of such architectures is complicated by the fact that there is, in general, no separation 
principle for nonlinear systems. In contrast to linear systems, “certainty equivalence” substitution of the states from 
even an exponentially converging observer into a nominally stabilizing state feedback control law does not 
necessarily guarantee stable closed-loop operation for the coupled systems 3,4 . 

However, in reference 2, a separation principle is found to exist for the problem of forcing the attitude of a rigid 
vehicle to asymptotically track a (time-varying) reference attitude using feedback from sensors with persistent 
nonzero bias errors. A persistency of excitation argument demonstrated that the bias estimates provided by the 
observer are exponentially convergent to the true bias values. Reference 2 also proves that the certainty equivalence 
use of the observer bias estimates in the nonlinear feedback control algorithm proposed in reference 5 resulted in a 
stable closed-loop operation, with asymptotically perfect tracking. 

Here we extend the analysis of reference 2 to include noise in the gyro reading. The Converse Lyaponov 
Theorem demonstrates that in this case the bias estimates provided by the observer converge exponentially to a 
mean square bound proportional to the variance of the noise. We then consider the certainty equivalence use of 
these observer estimates in the nonlinear feedback control algorithm and show that, as in reference 2, the 
perturbation introduced by this strategy into the closed-loop dynamics can be represented as a bounded function of 
the vehicle states multiplying the observer transients and the noise. We demonstrate that the stability properties of 
the controller are, in fact, maintained in the face of the perturbations, with asymptotic tracking to a mean square 
bound. 

The paper is organized as follows. Section II contains definitions of the terms used in the controller and 
observer. In Section III the nonlinear observer for the constant gyro bias with added noise is developed and the 
convergence is proven. Section IV presents the nonlinear controller design and the proof of stability of the closed 
loop system and the convergence of the tracking errors. Section V presents simulation results, followed by 
conclusions in Section VI. 
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DEFINITIONS 


The attitude of a spacecraft can be represented by a four component quaternion, consisting of a rotation angle and 
unit rotation vector, known as the Euler axis 
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where (j> is the rotation angle, e is the Euler axis, e and r\ are the vector and scalar portions of the quaternion, 
respectively. Note that ||qj| = 1 by definition. The quaternion represents the rotation from an inertial coordinate 
system to the spacecraft body coordinate system. A rotation matrix can be computed from the quaternion as 6 


R(q) = (ft 2 - e T e)I + 2e e T - 2 tiS(e) 
where S(e) is a cross product matrix formed from the vector e. 
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A desired target attitude is represented by the quaternion, q^ = [£ d >ftd] • The attitude error used in the controller 
is defined as a rotation from the desired body frame to the actual body frame and is computed according to 7 
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Similarly, in the observer, the attitude error is defined as the rotation from the estimated body frame to the actual 
body frame as 
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where q represents the attitude state of the observer. Note that e c = 0, rj c = ±1 indicates that the spacecraft is 
aligned with the desired attitude and, similarly, e 0 = 0, rj 0 = ±1 indicates that the attitude estimate is aligned with 
the actual attitude. 


The kinematics equation for the quaternion is given ; 
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where © is the spacecraft angular velocity. The angular velocity is typically measured by a gyro, which can be 
corrupted with both systematic and random errors. In the case of gyro bias and random noise, the gyro reading, © g , 
can be written as 


© g =© + b + v(t) 
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where co is the true angular velocity, b is the gyro bias (which in this work is treated without noise), and v(t) is an 
added noise. An estimate of the angular velocity is given as d> = ® g - b . The bias error is defined as the difference 
between the true and estimated bias 


b = b-b 


( 2 ) 


Finally, a measure of the discrepancy between the actual and desired angular velocity in the controller is 
computed as 7 


5 C = (a - R(q c )o> d 


(3) 


which is defined such that q c = yQ(q c )5 C . 

NONLINEAR OBSERVER FOR CONSTANT GYRO BIAS 

Following the development of reference 1, a state observer for the bias can be defined as 

q = ^■Q(q)R T (qo)(< fl g - b + k£ 0 sgn(q 0 )) (4) 

b = -ie 0 s i n (fio) (5) 

The gain, k, is chosen as a positive constant. The R T (q 0 ) resolves the angular velocity terms in the observer 
frame. 

Computing the derivatives of q 0 in ( 1 ) and b in (2) results in the following differential error equations 
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The above error equations are rewritten as 
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The system in (8) is divided into the nominal system of reference 2 plus a perturbation 

x(t) = f(t,x) + D(t) 


( 6 ) 

(7) 

( 8 ) 


where x T 




and D(t) T =[(-i[n 0 I + S(£ 0 )]v(t)) T 


0 . Through a persistancy of excitation argument, 


the nominal system x(t) = f(t,x) is proven to be exponentially stable 2 . Therefore, according to the Converse 
Lyapunov Theorem 3 , a Lyapunov function and positive, finite constants c t , c 2 , C3, and c 4 exist and satisfy the 
following 
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The perturbed Lyapunov function then satisfies 
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Since Q t Q = I , ||D = v and (9) becomes 


Vo^-c 3 H 2 +^-1x||v|| (10) 

If v(t) is uniformly bounded, the system is globally stable. The state x(t) converges exponentially to a ball 
determined by the bound on v(t) , and then remains within that ball 3 . 

Consider the case that the noise v(t) is a bounded, zero mean, wide sense stationary (WSS) process with a mean 
square value of ct 2 I. Applying Young’s inequality 4 to (10) results in 




( 11 ) 


The time average of (1 1) is computed as 


ll 0 T |x| 2 dr < ^Jo T H 2 <1t + ^[V o (0) - V 0 (T)] 
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Taking the limit as T — » <x> 
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The root mean square (RMS) bound is then given as 
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NONLINEAR CONTROLLER DESIGN 

The complete attitude dynamics for a rigid spacecraft are given as 

Hob - S(Hoa)o) = u 
q=^Q(q)o> 


where H is a constant, symmetric inertia matrix and u is the applied external torque, for example, from attached 
rocket thrusters. The goal of the controller is for the actual, measured attitude q(t) to asymptotically track a 
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(generally) time-varying desired attitude q d (t) and angular velocity co d (t), related for consistency by 
q d = 2 _ Q(qa) <0 d • It is assumed that co d (t) is bounded and differentiable with d) d (t) also bounded. 

The passivity based controller of reference 5 utilizes the composite error metric 

s = £5 C + Xz c = to - «> r (12) 

where from (3), to r = R(q c )to d - Xe c , X>o. Taking the derivative of (12) and multiplying by H results in 

Hs = Hcd - H<» r = u + S(Htt>)tt>- Ha r (13) 

where 

a r = d) r = R(q c )<b d - S(5 C )R(q c )© d - ^Q, (q c )S C 
and Q,(q c ) = rj c I + S(e c ) as defined above. With these definitions, the control law 

u = -K D s + Ha r -S(Hio)o> r (14) 

for any symmetric, positive definite K D results in closed-loop dynamics 

Hs - S(Hco)s + K D s = 0 

As shown in reference 5, these dynamics, together with the definition of the composite error, produces the desired 
stability and tracking properties. 

In the current application, the control law (14) cannot be implemented because exact measurements of the 
angular velocity <D are not available. Instead a certainty equivalence approach is employed using the estimates d) 
from above, resulting in 

u = -K d s + Ha r - S(Hd>)to r (15) 

where s = d) - co r , <o c = d> - R(q c )w d , and 

« r = R(qc)®d +S(R(q c )o> d )S c -M5,(q c )5 c . 

Substituting (15) into (13), along with (12), and noting that s =s-s = -b-v(t), 
a r = [-S(R(q c )to d ) + XQ, (q c )](b + v(t)) , and S c - oo c = to - to = -b - v(t) produces the closed-loop dynamics 

Hs - S(Hto)s + K d s = [S(ei r )H + HS(R(q c )to d ) - XHQ,(q c ) - K D ](b + v(t)) (16) 

The terms on the right hand side of (16) can be rewritten as A(q c ,co d )(b + v(t)) . Since ||q c || = 1 by definition and 
|w d || < oo by assumption 

Y s sup sup j|A(q c , co d (t))j| < oo 
»to ||q c H 
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Using the Lyapunov function V c = yS T Hs , the derivative of V c along closed-loop trajectories of (15) satisfies 
the inequality 


V c = -s t K d s + s T A(b + v) < -k D s 2 + y s ( b + v 


where k D is the smallest eigenvalue of K D . Using Young’s inequality 4 on the last term above, V c is rewritten as 

-<|jbf+H ! ) (17) 
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Thus, from the definition of V c , and recalling from the observer analysis that b and |v|| are bounded, s is also seen 

to be uniformly bounded. Similarly s is uniformly bounded, since all the terms in (16) are bounded. Integrating 
(17) 
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Substituting s 2 = ||5 C | 2 + 2kai 4 £ c + X 2 e c | 2 from (12) 
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Noting that w 4 e c = 2rj c , (18) is then 
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Computing the time average of (19) and taking the limit as T — > <x> 
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The RMS limit of the tracking error is then 
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SIMULATION RESULTS 

The spacecraft attitude controller/observer design is tested with a Matlab simulation. The inertia matrix is a 
diagonal matrix with principal moments of inertia of [90, 100, 70] T kg-m 2 . Table I lists the initial conditions for the 
observer and controller, as well as the true gyro bias, true initial angular velocity, and desired angular velocity. The 
gains are chosen as k=l, K D =k D I with k D =10, and X=3. The standard deviation of the gyro noise was first set to 0.57 
deg/sec and then to 0.057 deg/sec. 

Figures 1 and 2 show the observer bias errors with the two different standard deviations for the gyro noise, 
respectively. In each figure the top plot shows ||b(t)|and the bottom plot shows the ||b(t)| RMS . In Figure 1, 
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||b(t)|j converges to less than 0.3 deg/sec, and in Figure 2 to less than 0.03 deg/sec. In both cases, the RMS errors 
are less than the standard deviation of the gyro noise. 

Figures 3 and 4 show the attitude tracking error from the controller, again for the two different standard 
deviations of the gyro noise. In each figure the upper plot shows the angular error and the lower plot shows 
||e c (t)|| RMS . In Figure 3 the attitude error converges to less than 0.4 degrees and to less than 0.04 degrees in Figure 

4. Note that the RMS error of the vector part of the quaternion is plotted with the standard deviation of the gyro 
noise (converted to rad/sec) for comparison of the magnitudes only. 


Table I. Simulation Initial and True Values 


Variable 

Initial Value 

q 

[0,1,0, 0] T 

q 

[0, 0,1, 0] T 

qd 

[0, 0,0, 1] T 

b 

[0, 0, 0] T deg/sec 

to - true 

[-5.7,1 1. 4, -22.9] 1 deg/sec 

b - true 

[2.9, -2.9, 1.9] T deg/sec 

09 d 

[0, 6.3, Of deg/sec 




Figure 1. Bias Errors - b(t) and [|b(t)|| RMS (solid lines), and a=0.57 deg/sec (dashed line) 
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Figure 2. 


Bias Errors - b(t)| and |5(t)|| (solid lines), and o=0.057 deg/sec (dashed line) 




Figure 3. Attitude Tracking Error, |e c (t)|| RMS (solid lines), and a=0.01 rad/sec (dashed line) 
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Figure 4. Attitude Tracking Error, |je c (t)j| RMS (solid lines), and o=0.001 rad/sec (dashed line) 


CONCLUSIONS 

A nonlinear controller/observer is presented for spacecraft attitude applications, given a constant gyro bias and 
gyro noise. The gyro bias estimates converge exponentially to a mean square bound determined by the standard 
deviation of the noise, relying on a persistency of excitation argument, which proves asymptotic identification of the 
gyro bias in the absence of noise. The nonlinear controller is a passivity based controller. The control input requires 
the use of the gyro bias estimate from the nonlinear observer. The closed loop stability properties of this nonlinear 
controller coupled with the nonlinear observer are analyzed and the system is found to be globally stable, leading to 
a separation principle for the nonlinear system, with asymptotic tracking to a mean square bound. 
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